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Robotic arm use small or medium size embedded controller such as Arduino. Therefore, 


the control algorithm should be a small order of controller. The synthesized 
controller was tested using MATLAB and then implemented on the real 
hardware to control a robotic manipulator. Both the simulation 
and the experiment showed that the proposed controller performed satisfactory 
results. It can control the joint position to the desired position even in 
the presence of uncertainties such as unmodelled dynamics and variation 
of loads or manipulator poses. 
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1. INTRODUCTION 

During decades, many researchers have been trying to control non-linear system using linear 
techniques. Gain scheduling and various of Hoo approaches were used [1-4]. Robotic arm is one example 
of a non-linear system. Several researches tried to control it using linear approach [5-8]. All of these approaches 
resulted very high order of controllers that are difficult to be implemented in a small embedded system [9]. 
Another research synthesized a conventional high order Hoo controller and tried to reduce the order using 
control reduction method in Matlab [10]. The conventional high order Hoo controller results were 10" 
to 13th order of controllers. The reduction method resulted around 4" to 7" order of controllers which are still 
too high for a small embedded system like ATMEGA328 in Arduino board. 

This paper proposes a low order H2/H.~ robust controller that is possible to be programmed on 
a small embedded system like Arduino board with ATMEGA328 microcontroller. The controller synthesis is 
explained in the paper and tested to control a low-cost small industrial or educational robotic arm joint. 
A low-cost robotic arm may have lower price but consequently, it may have some lower specification 
such as resolution, power, repeatability, and so on compared to the expensive commercial one. 
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Out of the specifications that actually can be chosen based on the components that are used, stability is an 
important parameter that cannot be bargain. Even for the low-cost robotic arm, guaranty of robust stability 
and robust performance is a must. Ho under bound uncertainty is a controller that guarantee robust 
stability [11-14]. Hoo controller works as an optimal controller that does not provide the best performance 
of the system but provides the optimal performance in the range of uncertainties [15]. To guarantee robust 
performance as well, H2/H. mixed sensitivity is used. Hoo controller synthesis always results a very high order 
of controller that is not easy to implement in practical embedded system moreover in a small controller like 
Arduino. Arduino is a small low-cost controller that now is very popular among practitioners. The proposed 
controller is a low order controller which has predefined structure that can guarantee robust stability and robust 
performance. The structure was specified before the controller synthesis, and the order of the controller was 
also set to meet the specification of the controller hardware. 

The chosen structure in this research is proportional integral derivatif (PID) structure. The reason is 
because PID controller has been widely used in variety application [16]. Other than that, PID 1s good enough 
for linear position control and used a lot in robotic control. Even the structure is just in the form of PID 
controller or some people may ask why the so-called Hoo controller now just a PID controller, it has been 
optimized using robust controller cost functions. It no longer gives the best response system in terms of rise 
time, settling time, and overshoot, but it provides stability and guarantees the performance even in 
the presence of uncertainties or disturbances. Nonetheless, the controller will perform satisfactorily 
if the uncertainties and disturbances remain in the same set range when the controller was designed. 
PID controller needs to be re-tuned everytime there are changes in the system or environtment. 
Whereas robust control gain is applicable in all cases [17]. The reason in choosing H. controller is because its 
capability in handling disturbance cancelation and robust stabilization of uncertain system. 
However, the drawback is in its transient response behavior [18]. Another robust controller with simple 
structure is sliding mode controller. But this controller has a chattering effect when the sliding surface 
is reached [19]. 

Comparisons of proposed controller and regular PID controller is presented in this paper. 
The proposed controller synthesis and the comparison to PID controller were tested on the base join 
of the robot. Load variations were applied during the comparison to see the controller performance under 
uncertainties. Novelty that is proposed in this paper is a small order with simple structure of H2/H. robust 
controller. Therefore, the controller is possible to be implemented in a small microcontroller like Arduino. 


2. RESEARCH METHOD 
2.1. Hardware design of the robotic arm 

The robotic arm is an articulated 3DoF manipulator. The detail of the design is shown in Figure 1. 
The robot manipulator is made of steel and mostly aluminium. Detail specification is provided in Table 1. 
For a low-cost robotic arm manipulator design, brushed dc motor is used here instead of brushless dc motor. 
Brushed dc motor is less expensive but brushed dc motor actually has several advantages such as higher 
efficiency and reliability, have longer lifespan, and faster torque response [20]. The low-level position control 
is implemented in Arduino. Two Arduino UNOs are needed to control all the three manipulator’s joints. 
One UNO is used for inverse kinematic and control the base motor. The other one is used to control the hip 
and knee motors. The two UNOs talk each other using [2C protocol. Wiring diagram of the electric components 
is shown in Figure 2. 





(b) 


Figure 1. (a) Robot prototype, (b) Mechanical design of 3DoF articulated robotic arm 
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Table 1. Hardware specification of the robotic arm 


Specification Value 
Max vertical stretch 1005 mm 
Max horizontal stretch 641 mm 
Base Motor Power & Speed 250W/270 rpm 
Shoulder Motor Power & Speed 250W/270 rpm 
Knee Motor Power & Speed 250W/31 rpm 
Degree of Freedom 3 









shoulder 
motor 





Arduino and ESS knee 
motor driver motor 


Figure 2. Controller connection of the robotic arm 


2.2. Kinematic of the robotic arm 

The kinematic coordinate system of the robot is shown in Figure 3. Based on the reference coordinate 
system, the Denavit-Hartenberg parameters are provided in Table 2. Inverse kinematic of the robot manipulator 
was derived using this Denavit-Hartenberg parameters. Based on the calculation of inverse kinematic of an 
articulated manipulator in [21], the joint angles are derived from the known end point position (x, y, Z). 
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which a;, a; di, and 0; are the Denavit Hartenberg parameter shown in the Table 2 and Figure 3. 


2.3. Identification model of the robot manipulator 

The system was investigated as a decoupled system. Each motor was loaded with the rest 
of the manipulator frame to the arm tip included the rest of the dc motor and its gearbox. Since the investigation 
is firstly focused on the motor base, then the model derived is the equation of the dc motor base with the rest 
of the manipulator as its load. Equivalent of electrical circuit and mechanical diagram of a DC Motor 
is shown in Figure 4. The load it self is set to the maximum when the robot is stretched horizontally. 
The effect of load change can influence the movement of robotic arm manipulator [22]. Nominal transfer 
function dc motor position control and additional load inertia is obtained as: 
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O(s) 0.331 
VO 1.635exp—11s> +1.288exp-05s~ +0.1096s 


(6) 





Table 2. D-H Parameter of the robotic arm 
Parameter Link 1 Link 2 Link 3 


aj s d2 d3 
Qi 7/2 0 0 
d; 0 0 0 
O; 0; 02 03 






Amare 
circuit 






I - 





Figure 3. Reference coordinate systems Figure 4. DC motor electrical and 
on the robotic arm mechanical diagram 


2.4. 2Structure specified mixed sensitivity H2/H. controller 
Robust stability and robust performance against external disturbance will satisfy (7) 
if such controller K(s) is designed so that the closed loop of the nominal system is asymptotically stable [23]. 


J, =|W,(s) SGD], <1 (7) 


Multiplicative perturbation is upper bounded by stable function Wt(s). While the external disturbances 
is attenuated by astable function Ws(s). The robust stability against system perturbation satisfies the following 
inequality: 


J, =W ETO, <1 (8) 





Ws(s) : sensitivity weight 

Wt(s) : complementary sensitivity weight 

S(s) : sensitivity function 

T(s) : complementary sensitivity or transmissibility function. 

The idea of structure specified mixed sensitivity H2/H. control is to find an admissible structure-specified 
controller that minimizes the cost function J2 subjected to both constraints of J,a and J..,b. 


J, = fe (t)ar =E (9) 
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Following Skongestad’s method [13], after parameters substitution, the sensitivity weight for the base, 
shoulder, and knee motors 1s: 


0.5s+1 
ae (10) 
s+0.001 
The complimentary sensitivity weight (Ws) of the base control system is obtained as: 
B 1.26s° +57.22s +8.79 (11) 


mo g? +183.5s +3768 


The plot of the complimentary sensitivity weight and the system uncertainty singular value is shown 
in Fig. Figure show that the singular values of the inverse of the weight functions is larger than 
the sensitivity and the complementary sensitivity singular values which confirms IWs Sl<1 and [Wt Ti<1. 
In this research, a PID controller structure is selected as the structure of the proposed controller. 





Bode Diagram Bode Diagram 
L L 










































































50 T 100 r T T T l Tt 
~~ S(s) 
T(s) 
gi we sg 50 = sa ~ T/Ws(s) |. 
Fa y age SN ——— 1Mtis) 
-50 = a P 
g T o _ — 
® o \ 
5 -100- £ 
E D S S D _ 
-150 
Pa -100 - = 
-2005 7 Wt(s) 
Zo AG, 
-250 r r r -150 ~ È F r r r t 
10° 10° 10° 10° 10" 10° 10° 10 10° 10° 
Frequency (rad/s) Frequency (rad/s) 
Figure 5. Complimentary sensitivity weight Wt Figure 6. The sensitivity, complementary 
and the system uncertainty of sensitivity, and their inverse weight singular 
the base joint control values of the base joint 
Ki Kad.s 
K(s)=Kp+—+ (12) 
s Ns+l 


2.5. Particle swarm optimization 

Particle Swarm Optimization or PSO is an evolutional method that adopt social behavior of birds to 
optimize objective function [24]. In this research, PSO is used to minimize the objective function J2 from (9) 
subjected to both constraints of /..,, and fp from (7) and (8). As long as the constraints of J,a and Ja» are 
fulfilled, the minimization of f+, will generate the swarm’s positions as the controller constants. 
Any repetition of the PSO optimization process with any parameter changes, will generate different controller 
constants combination. As far as all the f. constraints are fulfilled, each combination will form 
an optimal robust controller that satisfy the robust stability and robust performance against external 
disturbance [13]. A group of random particles is used to initialized the PSO at the first time. In each iteration, 
PSO searches for optima by updating generations using best fitness value or the best position of particle P;(k) 
and best particles value or the best global position G(k). In every updating process iteration, PSO updates 
the velocity and the position following (13) and (14). 


V, (k +1) = W.V, (k) +c,.7,.(P (k)-x, (k))+c,.r,.(G(k)-x, (k)) (13) 
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The search space is N-dimensional, so the dimension of position vector of particle 1 is also N, 
X, = (X, X35... Xy ) The dimension of velocity vector is N, Vv, =(V,,,V,5,---.V.)- The objective function 
evaluates the fitness of particles. Individual best position p, =(P,,, P;2»--- Piy ) is the best previous position 


of particle 1. The w is inertia weight, rl and r2 are random variables ranged between 0 to 1, cl and c2 are 
coefficients of acceleration. The velocity is kept in the range of —vmin to vmax. Global best position is the best 


individual position of the whole swarmG=(g,,Q,,....2,)- The velocity and the position 


of the particle are updated every iteration. Flow chart of PSO is depicted in Figure 7. 







? 


Figure 7. Flowchart of particle swarm optimization 











The parameters of the PSO are set as follows: swarm size = 20, dimension of the particle is 4 (kp, ki, kd, 
and td), cl = c2 = 2, number of maximum generation = 100. The inertia weight is changed from 0.95 to the 
final weight 0.4, and the velocity is limited at [-vmin,vmax] = [-100,100]. Following the controller structure in 
(12), the kp, ki, kd, and td are replaced with the results from the PSO. The best particles from the iteration is 
put on the equation to replace the four PID parameter. This generates one combination of best H2/ H. robust 
controller in the form of simple PID structure. One combination result is obtained as: 


0.0000069 1, 234s 
as + 


——_ (15) 
s 0.000735s + 1 


K(s)=11.554+ 


With the Jog = 0.61121, Jo» = 0.9963, and J2 = 0.1503. 
The optimization process is not put on the Arduino embedded system due to its large search space and long 
fitness calculation [25]. 


3. RESULTS AND ANALYSIS 
3.1. Simulation result 

The proposed controller showed in (15) is a robust controller in a simple PID structure. 
Figure 8 shows that the proposed controller can control the robot’s base joint under various uncertainties. 
The simulation was conducted under uncertainties as shown in Figure 5. In term of stability, all the responses 
are stable, have good rise time, no overshoot and steady state error which is important in robotic arm 
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control [26]. The result was compared to other three controllers derived using MATLAB toolboxes 
which are: 
- Full order Hə robust controller derived using MATLAB command “mixsyn’, 
- Structure specified Ho robust controller derived using MATLAB command “hinfstruc?’, 
- Auto tuned Proportional Integral Derivative (PID) Controller. 

Figure 9 shows response system using full order H» robust controller. A classic synthesis of high order 
H. robust controller can be derived automatically using MATLAB command “mixsyn”’. 
The result controller using “mixsyn” command is: 


1.546 x 10°.s* + 1.218 x 10*.s*+ 1.059 x 1015.27 + 1.907 x 10° + 3.906 x 101” + 4.001 x 10°* 16 
It is a six order of controller. The plant itself is a third order transfer function. Therefore, the controller 
combines with the plant itself result a nine-order system which is actually very difficult to be implemented on 
an embedded system controller. However, in this case we just compared it in simulation using MATLAB. 
The response of the system is quite stable, except the rise time and the settling time is still too long. Figure 10 
shows response system using another structure specified Ho robust controller but it was derived directly using 
MATLAB command “hinfstruct’. The controller equation 1s: 


25.5478 
K (s) =10.1037 + ———-_ + 0.1578 (17) 
S 


The structure chosen is also PID structure. The result is also quite stable. However, it has overshoot. 
Even small overshoot, but it is quite dangerous for some robotic arm application if we have overshoot. 
The end effector may have hit the target before it reached the position. Lastly, we generated an auto tune PID 
controller using MATLAB. The controller equation is: 


1087598.31 37214.7841 
+ 0.5531 (18) 








K (s) =7172.4416 + 


s 1 
1+ 37214.78 x — 


S 


The controller was tuned in nominal value of the plant. Later on, the controller was tested with the same plant 
but the same uncertainties were applied on the system. The response system are shown in Figure 11. 
The response of the system in the nominal plant was very good. However, in some uncertainties, 
there were some significant overshoots. 
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Figure 10. System response using structure 
specified H» robust controller 
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Figure 11. System response using auto tuned 
PID controller 


3.2. Experimental Result 

The synthesized controller was programmed into the controller hardware. The hardware response 
system is shown in Figure 12. There were some steady state errors due to some uncertainties. However, 
the resolution of the encoder is very small. The maximum error that happened for the maximum load 
and the arm is stretched horizontally is less than 0.1°. All the arm stretched horizontally is a rare configuration 
in daily work of the robot. So, in normal works the robot still has good position control repeatability. 


Hardware experiment under uncertainties 
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200 


Figure 12. Hardware response system using the proposed controller 


4. CONCLUSION 

The 3DoF articulated robot manipulator has been developed. A low order H2/ H. robust controller in 
the form of simple PID structure has been successfully synthesized. The proposed controller was sintesized 
using Particle Swarm Optimization with integral of squared error cost function in the constraint of robust 
stability and robust performance functions. Computer simulations and hardware experiments showed that 
the controller is able to control the robot’s base joint motor position even in the presence of uncertainties. 
The proposed controller also gave better responses compared to a full order Hs robust control, 
structure specified H. robust controller, and an auto tune PID controller in the presence of uncertainties. 
In the hardware simulation there was a small steady state error maximum around 0.1° that happened 
at the maximum uncertainty. For certain application this value is still acceptable. Especially for educational 
robot, it still can be used for teaching and learning equipment. Future work is to synthesis another robust 
controller to control the rest of the joints. For the hardware, additional two or three degree of freedom 
manipulator will be added on the tip of the robot. It will control the orientation of the end effector. 
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